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FOREWORD 


This final report documents and summarizes the work accomplished 
by the Electrical Engineering Department, Auburn University, in the 
performance of Contract NAS8-27827 granted to Auburn University, Auburn, 
Alabama. The contract was awarded July 23, 1971, by the George C. Marshall 
Space Flight Center, National Aeronautics and Space Administration, 
Huntsville, Alabama. 
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SUMMARY 


This report applies multivariable control theory to the design of 

a hierarchial attitude control system for the CARD space vehicle. The 
system selected uses reaction control jets (RCJ) and control moment gyros 
(CMG) . The RCJ system uses linear signal mixing and a no-fire region 
similar to that used on the Skylab program; the y-axis and z-axis systems 
which are coupled use a sum and difference feedback scheme. The CM3 system 
uses the optimum steering law [4] and the same feedback signals as the 
RCJ system. When both systems are active the design is such that the 
torques from each system are never in opposition. 

A state-space analysis was made of the CMG system to determine 
the general structure of the input matrices (steering law) and feedback 
matrices that will decouple the axes. It is shown that the optimum 
steering law and proportional-plus-rate feedback are special cases. 

A third part of the report is a derivation of the disturbing 
torques on the space vehicle due to the motion of the on-board 
television camera. A simple procedure for computing an upper bound 
on these torques (given the system parameters) is included. 
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I. INTRODUCTION 


The attitude control of a spacecraft visiting comets and asteroids 
for scientific study requires a multivariable attitude control system. 
During the journey from earth to rendezvous with the target (comet or 
asteroid), the attitude control is provided by the thrust vector control 
(TVC) system, the propulsion being supplied by a solar electric system 
augmented by a chemical propulsion unit. When the spacecraft rendezvous 
with the target, the attitude control for station keeping, docking, and 
separation from the target requires more capability than the TVC system 
can provide. 

The objective of this study was to design a highly reliable attitude 
control system for experiment pointing, station keeping, docking and 
separation from the target for the Comet and Asteroid Rendezvous and 
Docking (CARD) space vehicle [1]. Early in the study it was determined, 
that a combination of a reaction control jet (RCJ) control system and 
a control moment gyro (CMG) control system properly mated would be a 
good approach. Such systems have been successfully used on other space 
vehicles although problem areas still exist [2]. 

The RCJ system is by nature an on-off linear control system and 
for small errors will limit cycle; energy to generate torques is from 
an ever- decreasing supply of pressurized gases. On the other hand the 
CMG system is a continuous non-linear control system using solar 
energy to maintain the spinning of the gyros. For small disturbances 
the CMG system can keep the attitude errors inside the RCJ system dead- 
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band. The RCJ system is available to desaturate the CMG system and to 
correct for large disturbances. 

The design objectives given primary consideration were: 

(1) Minimize fuel consumption when the RCJ system is the only 
active system, and when both systems are active design 
the system so that the torques produced are never in op- 
position. 

(2) Minimize coupling between the three axes of the attitude 
control system. 

The spacecraft's general appearance, size, configuration, inertias, 
etc., were taken from the Northrup Services, Inc., final report of its 
feasibility study £lj . Figures 1-1, 1-2, 1-3 are taken from that report 

An additional area of study included in this report concerns 
the disturbances on the spacecraft due to the motion of the scanning 
platform on which is mounted the television camera. A procedure to 
compute the disturbing torques as a function of the television camera 
inertias and scanning rates is included. 





y Z AXIS (ROLL) 



Figure 1-2. Baseline CARD Planetary Vehicle Concept (from Ref 1) 



Figure 1-3. Baseline CARD Planetary Vehicle Concept (from Ref 1) 



II. THE REACTION CONTROL JET ATTITUDE CONTROL SYSTEM 


The attitude control system controls the orientation of the space- 
craft with respect to the XYZ axes; the outputs are the angles <J> X , <P y , 
<p z . The reaction control jet (RCJ) attitude control system uses cold 
gas thrusters to produce torques about the spacecraft center-of-gravity. 


The location of the thrusters is taken from [1] ; the numbering c£ the 
thrusters and the spacecraft axes are as shown in Figure II-l. The space- 
craft center-of-gravity is at the origin of the XYZ axes and it is as- 
sumed that the thrusters produce torques in the Y-Z plane. 

To simplify the analysis the dead- time, rise-time and decay-time of 
the thrusters are neglected; in addition it is assumed that all thrusters 
produce the same torque with no misalignment. Once an engine is acti- 
vated it is assumed to continue to produce a constant torque for at least 
fifty milliseconds. This is a commonly used value. 

The X-axis control system uses thrusters which produce no torques 
about the Y or Z axes. The control system uses proportional-plus-rate 
feedback with a saturation block in the position feedback path. This 
produces a no-fire region similar to that used in the Skylab program [2]. 

Figure II-2 contains a block diagram of the X-axis control system 
and a phase-plane showing the boundaries of the no-fire region. The con- 
troller parameters were calculated assuming that the system deadband, 

and the saturation value, <J>r» were specified and that a trajectory 
originating on the rate limit boundary would intersect the <f> x axis at 

. The specification represents a compromise between fuel consump- 
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Thrusters 9, 11, 13, 15 produce 
forces out of paper 
Thrusters 10, 12, 14, 16, produce 
forces into paper 




NOTE: Attitude control thrusters are larger than scale 

to shov numbering system. 

Figure II-l. RCJ Attitude €ontrol Thrusters 
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tion and steady-state accuracy; the rate ledge specification represents a 
compromise between fuel consumption and speed of response. 

Aj x is computed in the following manner: 

Assume <J> C = 0 and e x < - 4>db so that 


♦ x = £ = — M 

x dt * 


(II-D 


Also d<j> 5 


(II-2) 


Dividing (II-2) by (II-l) yields 


= - <f> 


or d<J> x = - 4> x d<|> x 


Integrating and requiring that the trajectory go through (4>db»^ yields 


1 /Jx- 

2 v 


+ 4> x = 4>db 


(II-3) 


For - 4>r, < <f> < , the boundary is given by 

Xv X — Xv 


e x = " *db = " (A lx *x + V 


(II-4) 


For the curves given by (II-3) and (II-4) to intersect at 
“♦u requires that 


A lx ' 


+ *db 
2M* 


(H-5) 
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( <fr R - <(> db ) 'f~2~ 

The rate ledge is — ■ ■ 

^ (<f> R + W 


Since the Y and Z axes share thrusters a linear-signal-mixing scheme 
[3] is used to insure that opposing thrusters are not energized at the 
same time. A block diagram of the system is shown in Figure II-3. Ajy 
and Ajz are calculated in the same manner as Ajr. 

For the digital simulation the rate ledge is taken to be 0.172 
degrees /second. From [1] <)> db = 0.3° and the acceleration produced in 
each axis, for error in that axis only, and the thrusters producing the 
acceleration are: 

o 

X axis: Solar panels rolled: +.208 deg/sec ^ 

(pitch) Solar panels extended: +.031 deg/sec 

+$_ produced by thrusters 1,3, 5, 7 
-$ x produced by thrusters 2, 4, 6, 8 

Y axis: Solar panels rolled: +.0391 deg/sec 2 

(yaw) Solar panels extended: +.0214 deg/sec 2 

+3>y produced by thrusters 9, 11, 14, 16 
-$y produced by thrusters 10, 12, 13, 15 

Z axis: Solar panels rolled: +.0378 deg/sec 2 

(roll) Solar panels extended: +.0126 deg/sec^ 

+f z produced by thrusters 10, 11, 13, 16 
-$ z produced by thrusters 9, 12, 14, 15 


Some typical trajectories are given in Figures II-4 and II-5. 

A modification to this system was made which gives promise of better 
performance. In place of feeding the position signals $ and <J> Z to the 
saturation blocks, tfie sum and difference, ($y + <f>z) and (<j> z - <j>y) are 
the inputs to the saturation blocks. The block diagram of this system is 
given in Figure II-6. Figure II-7 is a phase-plane plot showing the bounda- 
ries of the no-fire region. Figure II-8 is a typical trajectory for this system. 



1 ] 



Figure II-3. Y-and-Z-axia RCJ Altitude 
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System Block Diagram 
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RESULTS 
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$ zo = 0.0°/sec. 
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Time to reach and remain inside 
deadband: 

y - 48.60 secs, 
z - 28.85 secs. 


2. Fuel consumption at: 

^ly = 4-080 48.60 secs: 52.0 

28.85 secs: 28.5 

^lz “ 4.176 unit is the energy consumed 

RATE LEDGE = 0.172 b y °? e thruster firing for 1 

S6C • ) 

Figure II-4. Phase-plane Trajectories of RCJ System" 
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*db " ±- 3 ° 
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M z = .0378 
A l y = 4.080 
A lz = 4.176 
RATE LEDGE = 0.172 


RESULTS 

1. Time to reach and remain inside deadband 

y - 67.55 
z - 54.00 

2. Fuel Consumption: 

67.55 sec: 49,1 
54.00 sec: 30.0 

(1 unit is the energy consumed by 1 
thruster firing for 1 sec) 


Figure II - 5 Phase-plane Trajectories of RCJ System 
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RESULTS 


*yo = 10 - 0 ° 
i yo = 0.0° /sec 

* z o = 5.0° 

<(>_- = 0. 0°/sec 


4>db = ±* 3 ° 
Mi, - .0391 


M z = .0378 


A-^y = 4.080 
A^ z = 4.176 
RATE LEDGE = 0.172 


1. Time to reach and remain inside deadband: 

y - 84.35 sec 
z - 87.8 sec 

2. Fuel consumption at: 

84.35 sec: 27.3 

87.8 sec : 27.3 

(1 unit is the energy consumed by one thruster 
firing for one sec) 


Figure II-8. Phase-Plane Trajectories of RCJ System — Sum and Difference Saturation Signal 
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Comparing the data presented in Figures II-4 and II-8, it can be 

seen that the modified system is slower but the fuel consumption (based 

on both the <f> and <j> errors being less than the deadband value) is re- 
y z 

duced. Further work is needed to determine if the rate-ledge and feed- 
back gains can be changed so that the modified system has comparable 
speed of response with less fuel consumption. It should be noted that 
with this modification the ($ z + 4> y ) controller and the (<f> y - <t> z ) con- 
troller are decoupled even when the saturation limits are active; thrusters 
11, 12, 15, 16 are active for (<j> z + 4> y ) errors and thrusters 9, 10, 13, 14 

are active for (<j> z - <J> y ) errors. 



III. TEE CONTROL MOMENT GYRO ATTITUDE CONTROL SYSTEM 


The control moment gyro (CMS) attitude control system also 
controls the angles <j> x , <py, 4> z . The control system simulated in this 
study uses the optimal steering law proposed in [4]. The CMG cluster 
arrangement is shown in Figure III-l. Part A of this section gives the 
block diagram and system equations in matrix form as taken from [4]. 
Part B is a general state- variable analysis to determine the general 
structure of the input and feedback matrices that will decouple the 
X, Y, and Z axes. 

Part A. System Simulation Using the Optimal Steering Law [4] 

A block diagram of the system is shown in Figure III-2. With the 

* • • 

outer gimbals clamped, the outer gimbal rates 63(1), 63(2), 63(3) are 
zero. The equations for the reaction moments, in matrix form, are: 


m rxv 


” 61(1)“ 

“ryv 

[A] 

61(2) 

_ m rzv_ 


61(3) 


where 


(III-l) 


[A] = 


sin(il(l)) cos (63(1)) 
-sin(61(l))sin(63(l)) 
cos (<5 1(1)) 


cos(61(2)) 

sin (6 1(2)) cos (6 3 (2)) 
-sin(61(2))sin(63(2) ) 


-sin(61(3))sin(63(3)) 
cos (5 1(3)) 

sin(61(3)) cos (63(3)) 


The steering law [Tg] gives the commanded gimbal rates in terms of the 
commanded moments. 


(III-2) 
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61(1) c 


M 



cxv 

61(2) c 

- [T q ] 

M 


D 

CYV 

61(3) c 





. czY 


(III— 3) 


Assuming that the actual gimbal rates are equal to the commanded gimbal 
rates, the relationship between the commanded moment and the reaction 
moment is : 


%XV 


n cxv 


= [A] [T s ] 

M 

CYV 

_ M RZV 


M 

_ czv 


(III-4) 


It is desirable that the reaction moment equal the commanded moment, 
which requires that: 


[A][Tg] • [I] , wherell] is the identity matrix. (III-5) 

0 


The steering law is thus given by 

[Tg] = £AJ ^ , where [A] * is the inverse of the matrix A. It 
should be noted that [A] is singular at some operating conditions. 

There is one vehicle control loop for each of the three axes. A 
rate-plus-position feedback is vised for each of the vehicle control 
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loops. The vehicle control law output is processed to obtain the moment 
command. This moment command is compared to the actual moment and 
the error is used together with the optimal steering law, to provide the 
proper reaction moment on the vehicle. 

A digital computer simulation of the three axis CMG attitude con- 
trol system has been written and is included in the Appendix. 

Part B. A State-Space Analysis of the CMG System (Clamped Mode) for 
Axis Decoupling 

The object of this analysis is to write the system equations in 
state-space form and determine the form of the input matrices and the 
feedback matrices that will minimize or eliminate the coupling between 
the X, Y, and Z axes. In the first phase of the study the torque 
motor dynamics are neglected but are included in the second phase. 

Phase 1. Torque Motor Dynamics Neglected 

The open-loop system is shown in Figure III-3. Let the states and 
the inputs be defined as 


— -* 


— - 



- • 

X 1 


*x 


U 1 


6 n 

X 2 

= 

l 

X 

; the input, _u = 

U 2 

= 

*12 

X 3 


y 


_ u 3_ 


.*«. 

x 4 


i 

y 




X 5 


*z 




x 6 


i 

_zj 





(III-6) 




Fig. Ill - 3. Block Diagram of Open-loop CMG System; Clamped Mode and Torque Motor Dynamics Neglected 
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Then the state-space equation is 


x = [A 0 ] x + [B] u 
where 



(III-7) 


(III-8) 


IBJ = 
6x3 


0 0 0 
1 0 0 
0 0 0 
0 10 


[JJ[A] 
3x3 3x3 


0 0 0 

0 0 1_ 

6x3 


(HI-9) 


To decouple the axes let 

u = [Ts] j>c + [Fj] jc where _£c 
3x3 3x6 


'f’cx 

^cy 


= desired output angles and (III- 10) 



[Ts] and [F^] are decoupling matrices. 
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Then 


x= {[Ao] + [B] [F x ]} x + [B] [Ts] ±c 


(III-ll) 


For the axes to be decoupled, 

0 0 

y 2l 0 

0 0 

0 Y42 

0 0 

0 0 

where the y's are nonzero. 


Thus [B] [Ts] = 


0 0 

Y 2 i 0 
0 0 

0 Y42 

0 0 
0 0 


[B][Ts] must have the form 
0 
0 
0 
0 
0 

Y 63_ 

0 

0 

0 

0 

0 

Y 63 


0 0 0 
1 0 0 
0 0 0 
0 1 0 
0 0 0 
0 0 1 


[JHAJ [Ts J 


(III-12) 
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[J] is a diagonal matrix of full rank, so this condition can be 
satisfied only if [A][Ts] is a diagonal matrix of full rank. 

In addition, [A«] + IB][F|] must have the form 


“11 

“12 

0 

0 

0 

0 “ 

“21 

“22 

0 

0 

0 

0 

0 

0 

“33 

“34 

0 

0 

0 

0 

“43 

“44 

0 

0 

0 

0 

0 

0 

“55 

“56 

0 

0 

0 

0 

“65 

“66 


where same a's in each sub-block are nonzero. Since [A 0 ] has the 
form, then [B][F^] must also have the above form. 


Thus [BHFj] = 


«11 

a 21 

0 

0 

0 

0 


ai2 0 0 0 0 

CX 22 0 0 0 0 

0 033 034 0 0 

0 043 0144 0 0 

0 0 0 a 55 a 56 

0 0 0 ct 65 a 66 


0 0 0 
10 0 
0 0 0 
0 1 0 
0 0 0 
0 0 1_ 


[J] [A] [F x ] 


above 


(III -13) 


(III-14) 
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This implies that £A] IF^] must have the form 


B 11 b 12 


b 23 b 24 0 


b 35 b 36 


where a B in each row must be nonzero to have a feedback signal. 
Thus the conditions for axes decoupling are that 

(1) {A][Ts] be a diagonal matrix 

(2) IAHFj] have the form 


B 11 b 12 


b 23 b 24 


0 0 0 


b 35 B 36 


Note that if 


b 12 = a constant times B^ 


b 24 = 


If II II It 


B ._ II II If It 

36 - 


then the feedback is proportional-plus-rate and the decoupling can be 
achieved as shown. 








where [Fj] 



If [A] [Ts ] = [I], the identity matrix, then this implements the optimal 
control law of [4J. 

Phase 2. Torque Motor Dynamics Included 


Assuming that the torque motors can be represented as first-order 
systems with time- cons tan ts , Tm, the open- loop diagram is as shown in 
Figure III-4 where uj , U£, U 3 are the input signals to the torque motors. 
The states and the input vectors are 


x 

z 


; u 


u. 


= input to the torque motors (III-15) 


’ll 


12 


’13 


Then the state-space equation is 


• 

X 


?Ao] 1 [B] 


X 

1 

[0] " 

• 

z 

L J 


I°J [-111] 
Tm 


z_ 

+ 

j= [II J 


(III-16) 




to 

VD 


Figure III-4. Block Diagram of Open-loop CMG System; 

Clamped Mode and Torque Motor Dynamics 
Included 
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To decouple the axes let 
u = [Ts] ±c + [ [F x ] | [F 2 ]] 

= [Ts] A c + [FjJx + [F 2 ]z (III-18) 

Thus 

x = [Ao]x + [B]z (III- 19) 

i - fel*2 - . US + fell'll* + fells lie (III-20) 

Assume that [A] , [Ts] , [F^ , and [F 2 ] are constant matrices for small 
changes about a steady-state operating point. Then 

x = [A„] x+ [B] A (III-21) 

= {[Ao]2 +JL[B][F,]}x + {[Ao][B] +1_[B][F 2 - I]}z + i_[B][Ts]lc (III-22) 
Tm Tm l m 

To decouple the axes, [B][Ts] must have the same form as in Part A and 
as before [A][Ts] must be a diagonal matrix. 

Continuing, 

x = ([Ao]3 + ^[B][Fi][Ao] + ^[A ] [B] [F]J + ^[B][F 2 - I][Fi]}x + 

{[A<J 2 [B] + -i— [B] [F,] [B] + i-[A ][B][F 2 - I] + ^r>[B][F 2 - I] 2 }z + 

Tm Tm 

[l_[Ao] [B] [Ts] + i_ [B] [F 2 - I] [Ts]}£c + i-[B] [Ts]J»c (III-23) 

Tm Tm^ Tm 


(III-17) 
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To decouple the axes, — [Aj[B][Ts] +^- 2 [B][F 2 - I][Ts] must have the 

Tm 9 Tm* * 

form 

Y n 0 0 

y 2 i ° ° 

0 Y 32 0 

; a in each sub-block 
® y 42 ® is nonzero 

0 0 *53 

0 0 *63 

The previous condition stipulates that [B][Ts]have this form. It is easy 
to show that [A°] [B] [Ts]has this form. Therefore [B] [F 2 ] [Tsjmust also 
have this form. This condition is satisfied if [F 2 ] is equal to a con- 
stant times the identity matrix. 

Let [F 2 - I] = k 2 {I] (III-24) 

then 

2 ^ - 4s ^ + ic (.111-25) 


and 

[B]Z - [B]Z + X + L B .U Ts 3 Ac 

“ Tm Xm Tm ■ 

and solving (III-19) for [B] Z gives 

[B]Z=^2X+ / jBHFl] . k 2 [Ao ]\ v 4 . [B] [Ts ] , c 
Tm y Tm Tm J Tm x 


(III-26) 


(III-27) 
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This substituted into (III-21) yields 

X = {[Ao] + k2[l]} X + f t B HFll _ k2 [Ao ]} x + M i l d, (III-28) 

— Tm “ Tm Tm Tm 

This equation yields an additional requirement for decoupling; [B ] [Fi ] 

must have the form 



where some a's in each block are nonzero. 

This result is the same as that derived in Part A and implies that 
[A][FjJ must have the form 



as was the case in Part A 

To summarize, the necessary structure of the matrices to decouple 


the axes is that 
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(1) [A][Ts] must be a diagonal matrix 

(2) [F 2 ] must be a constant times the identity matrix 

(3) [A][F 3 ] must have the form 

0 0 0 0 ~ 

®23 ®24 0 0 

0 0 B 35 B 3 g 

The system with feedback is shewn in Figure III-5. 

With proportional-plus-rate feedback the system takes the form 
of Figure III-6. In this form the [F 2 ] matrix, a k2[I] matrix, does not 
aid in the axes decoupling. However, if this diagram is redrawn in 
terms of the original set of variables in a modified form, Figure III-7, 
where it is assumed [Ts] is non-singular, then since it is desirable 
that [Ts][A] - [I] [Ts] ^ = [A], the system can be implemented as 
shown in Figure III-8. This is the system implemented in [4] with the 
objective that [Ts][A] = [I]. However, this cannot be accomplished under 
all conditions since [A] is singular (and thus [Ts]) at some operating 
conditions. This problem is minimized in J4J by proper selection of the 
angles at which the outer gimbals are clamped and by placing a limit on 
the minimum value of |det [A] j used in the computation of [Ts]. 
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A, 0 
lx 

0 

0 
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Figure III-6. CMG Closed-loop 
Clamped Mode. 



with Proportional-plus-Rate Feedback; 





















Figure 1II-8. Closed-loop System; proportional-plus - 
rate Feedback; Clamped Mode 















IV. COMBINED REACTION CONTROL JET AND CONTROL 
MOMENT GYRO ATTITUDE CONTROL SYSTEM 

The reaction control jet (RCJ) attitude control system and the 
control moment gyro (CMG) attitude control system are combined to 
operate as a single attitude control system. The objective was to 
mate the systems so that the torques generated by each system are 
never in opposition, speed of response is imp roved, and fuel consump- 
tion by the RCJ system is reduced. 

The RCJ system uses the sum and difference feedback control described 
in Section II of this report. The CMG system uses the same sum and dif- 
ference feedback signals as are generated in the RCJ system, e x , e y , e z . 

A block diagram of the CMG system is shown in Figure IV- 1. The satu- 
ration blocks in the position feedback paths are used to place the CMG 
torque reversal lines in the center of the RCJ no-fire regions. The phase- 
plane plot of the no-fire boundaries of the X-axis and a typical response 
are shown in Figure IV-2. A phase-plane plot of the no-fire region of 
the sum (<J> Z + <f> y) and the difference (<f> z - cfy) systems and a typical 
response are shown in Figure IV-3. The same data plotted for each axis 
is shown in Figure IV-4. 

The CMG system torques aid the RCJ system torques whenever the RCJ's 
are firing and the CMG torques tend to hold the RCJ system inside the no- 
fire regions. A digital computer program to simulate the combined systems 
is described in the Appendix. 
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Figure IV-1. CMG System with Sum and Difference Saturation Signals. 












rate limit 


CMG TORQUE 
REVERSAL LINE 


RATE LEDGE 


= 12.62 


RATE LEDGE 


RATE LEDGE = 0.172 

A lx - 0.14254 
<j>RX = 0*54516 

m - 500 




CMG TORQUE REVERSAL LINE 


FUEL CONSUMPTION =3.92 (ENGINE SEC) 


RATE LIMIT 


Figure IV-2. Phase-Plane Trajectory of Combined RCJ and CMG Svsfem 
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Figure IV-3. 


DESIGN PARAMETERS 
<j>db = + 3° 4*Ry = 1.0018 

RATE LEDGE = .172 ^ = 1.0182 

My = .0391 FPY = 1000 

Mz = .0378 FPZ = 1000 


RESULTS 

1. Time to reach and remain inside deadband 

♦x + “ 63.0 sec 

$x - - 21.4 sec 

2. Fuel consumption at 


A ly ■ 4 ' 080 Jy - 2947 63.0 sec - 

A lz = 4.1757 J z = 2918 21.4 sec - 

Phase-Plane Trajectories of Combined RCJ and CMG Systems 


5.92 Engine-sec 
5.92 Engine-sec 



INITIAL CONDITIONS 

DESIGN PARAMETERS 

RESULTS 

*t*yo 35 

• 

H* 

O 

o 

<t>db = + • 3° 

RATE LEDGE = .172 

1. 

Time to reach and remain 
inside deadband: 

<PyO 38 

0 /sec. 

My = .0391 

Mz = .0378 


Y - 60.4 sec. 
Z - 60.6 sec. 

<t»zo = 

• 

5° 

Ai y = 4.080 

A lz = 4.1757 

2. 

Fuel consumption at 
60.4 - 5.92 

q>zo * 

0°/sec. 

<j)gy = 1.0018 

38 1.0182 

FPY = 1000 
FPZ = 1000 
J y = 2947 
J z = 2918 


60.6 - 5.92 

(One unit is the energy 
consumed by one thruster 
firing for one second.) 


Figure IV-4. Phase-Plane Trajectories of Combined RCJ and CMG Systems 


V. COMPUTATION OF DISTURBING TORQUES DUE TO 
MOTION OF THE TELEVISION CAMERA 

The proposed CARD spacecraft has an on-board television camera which 
is used during orbiting or landing to view the terrain and proposed landing 
sites. The TV camera and its mount are constructed to permit rotation 
about two axes. The purpose of this section is to develop a procedure for 
computing the torques about the spacecraft center-of-mass produced by motion 
of the television camera. 

The general shape, dimensions, and mass of the TV camera and its mount 
are scaled from Figure 4.5 and Figure 4.83 of Reference 1. Based on these 
figures the TV camera and mount are assumed to have the general form and 
dimensions of Figure V-l. It will be treated as a rigid, homogeneous mass. 
The XY plane is a plane of symmetry and the XYZ coordinates of Figure V-l 
are parallel to the spacecraft XYZ coordinates. 

The additional assumptions made are: 

1. The spacecraft (main portion) angular velocities are small compared 
to the relative angular velocities of the television camera. 

2. The motion of the system (main portion plus the TV camera) center- 
of-mass due to TV camera rotation may be neglected in computing 
inertia characteristics. 

Part A. Derivation of Torque Equations* 

The inertia matrix of the TV camera and mount is 

*This approach was outlined by Dr. John E. Cochran, Assistant Professor 
of Aerospace Engineering, Auburn University. 
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II] - 


Z XX I XY 0 
I XY r YY 0 
0 0 i zz ^ 


(V-l) 


where certain cross-product terms are zero since the XY plane is a plane 
of symmetry. The direction the TV camera points is described in terms 
of two Euler angles; first a rotation about the Y axis and second a 
rotation 0 C about the Z c axis as is shown in Figure V-2. 

Let wi, W2, W 3 be the angular velocities of the TV camera about the 
x c y c z c axes respectively. Then in matrix form the angular momentum 
vector is 


I H Jx c y c Zc 


’ixx IXY 0 


•wi 

I XY I YY 0 


W 2 

.° 0 "zz. 


_ w 3_ 


The torque vector is 


IT] 


x c y c z c 


T 1 

t 2 

T 3 


d IH]x c y c z c 

dt 


(V-2) 


(V-3) 


Performing the indicated operation 15] , 16] yields 



^xx w l“ ■'■xy w 2 + *zz w 2 w 3 + ^xy w l w 3 “ *yy W 2 W 3 

• 

Ixy w 2“ ^xy W 1 “ ^zz w l w 3 + *xx w l w 3 “ ^xy W 2 W 3 

• 2 2 
I w,- I w. + I w-,w 0 - I w.w 0 + I w« 
zz 3 xyl yy 1 2 xx 12 xy 2 


(V-4) 
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where 




• 

"wi“ 


4< sin 0 

* c c 

• 

W£ 

SS 

V c cos 0 C 

• 

W3 


1 

0 

0 

1 


and 





W 1 


V c sin 0 C + ® c cos 0 C 

C 


'* • • 

w 2 

= 

V c cos 0 c - ¥ c 0 c sln 0 c 

• 

”3_ 


[ 

0 

CD 

1 


Let T x , T y , T z be the torques about the XYZ axes. 


(V-5) 


(V-6) 


The transformation 


is 


T x~ 


cos V c cos 

0c 

- cos ¥c sin 0c 

sin 

*c 


r n 

T 1 

T y 

= 

sin 0c 


COS 0c 

0 



t 2 

T 

z 


-sin y c cos 

0 c 

sin 4' c sin 0 C 

cos 

w 

c 


1 

CO 

H 

1 


(V-7) 


Performing the indicated operations results in the following expressions 
for the disturbing torques about the spacecraft center-of-mass, written in 
terms of the TV camera and mount inertias and the Euler angles © c an( * V P C J 


Tx - | lxx~ lyy sin 20 c “ Ixy cos ^®c | ^ cos ^c^ ^c 

jl zz sin + 

{(1^ - I yy ) cos 2 0 C + I zz + 2Ixy sin 20 c Hcos ¥ C > ? c 0 c + 

{I cos 20 c - ( Iyy ~ Iyy ) sin 20 c > (sin 4> c ) 

o 


(V-8) 



^6 


T = 

y 


{I„„ sin 2 0 P + I vv cos 2 0 C " sin 20 c > » c + 


XX 


T = 
A z 


'c ~yy c xy 

{ (1^ - I yy ) sin 20 c - 21^ cos 20 c } * c 0 C (V_9) 

{Ixy cos 20 C + < - I« + W sin 20 c }(sin V + 


(-21 


xy 


sin 20. + I,™ cos 20 c “ I xx cos 20 c z z 


c yy 


- I„_}(sin 'i' _) VJ/ c G c 


+ I (cos ? ) + 

ZZ C C 


j-VIjj sin 20 c + ijjy nos 20 c } (cos * c > *, 


(V-10) 


Part B. Computation of the Inertias for the TV Camera and Mount 

The TV camera and mount are considered as two rectangular blocks with 
centers-of-mass at Cj sad ^ respectively, as shown in Figure V-l. The 
equations to compute the inertias of rectangular blocks are well-known 
[6] and yield for M l, about C^ > 


Ix iyi 

= Mi(b 2 

+ 

c 2 ) 

= .28 

lb 

-ft 

2 

-sec 4 

12 







r yiyi 

= M^a 2 

+ 

c 2 ) 

= 1 . 

27 

lb- 

f t-sec 


12 







i 

= Ms (a 2 

+ 

b 2 ) 

= 1 . 

27 

lb- 

ft-sec' 

z i 2 i 

1 


— 






12 







where 

M x = 2. 
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lb- 

sec 2 /f t 





a = 2 . 

33 

ft 






b = 0. 

82 

ft 






c = 0.82 ft 



47 


For M„ about C 0 > 

2 2 

2 , 2v _ 


X 2 X 2 


= M 0 (b z + c ) = 0.285 lb-ft-sec 


x y 2 y2 ' ^ 


12 

= M,(c 2 + a 2 ) = 0.285 lb-ft-sec 2 


ZoZ 


12 

= M 0 (a 2 + b 2 ) = 0.378 lb-ft-sec^ 


2 Z 2 


12 


where 


M 2 = 1.72 lb - sec z /ft 

a =1.15 ft 

b = 1.15 ft 

c = 0.82 ft 


The parallel-axis theorem [6] is used to compute the moments-of-in- 
ertias of the two bodies about C. This yields 

— ■ o 

I = I + I Y „ V + M,Y, + M ?2 = 7.193 lb-ft-sec 2 

xx ix ixi x 2 x 2 n 2 2 

T _ T + I + Ml Xr 2 =2.34 lb-ft-sec 2 

A yy ” yiyi y2y2 


1 = 1, 


zz z l z l Z 2 Z 2 


+ 1 + M x (Y x 2 + X x 2 ) + M 2 <T 2 2 ) = 9<05 lb-ft-sec 2 


The non-zero cross-product term is 

X = m-iX.Y, = 2.22 lb-ft-sec 2 
xy ±11 

where the values of X^, Y Y 2 are listed on Figure V-l. 
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Part C. Computation of Disturbing Torques 

The inertias computed in Part B are substituted in (V- 8 ) , (V-9) , 
(V-10) . The resulting equations are 

T x = {2.425 sin 20 c - 2.22 cos 20 c }(cos 4' c ) + 

•* 

9.05 (sin ¥ c )e c + 

{4.85 cos 20 c + 9.05 + 4.44 sin 20 c }(cos T c )T c 0 c + 

{2.22 cos 20 c - 2.425 sin 20 c >(sin (V-ll) 

T = {7.19 sin 2 9_ + 2.34 cos 2 0. - 2.22 sin 20 C }'J' C + 
y c 

{4.85 sin 20 c - 4.44 cos 20 C )4' C 0 C (V-12) 

T = {2.22 cos 20 r - 2.425 sin 20 c }(sin ¥ c )¥ c + 
z c 

9.05 (cos T C )0 C + 

{- 4.44 sin 20 c - 4.85 cos 20 c - 9.05}( s in + 

{-2.425 sin 20 c + 2.22 cos 20 c >(cos V c >$ c 2 (V-13) 

To obtain numerical values for the disturbing torques it is necessary 
to assume scanning rates and accelerations for the TV camera. It is 
assumed that these values are bounded by 

-lO°/sec<_0 c , 1 + 10 °/ sec ( - 174 rad/sec) 

-10°/sec 2 1 0 C , ? c 1 + 10°/sec 2 (.174 rad/sec 2 ) 

Interest is in th°se conditions which result in large disturbing torques. 
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The entries in Table 1, except for the one designated "upper bound" (but 
not least upper bound) were computed for selected values of 0c and Vc 
by assigning scanning rates and accelerations so all terms are of the same 

sign and thus additive. 

The entry in Table 1 designated the "upper bound" was computed by 
maximizing (or minimizing) each term in (V-ll) with respect to 0 C and 
assigning the polarity of the scanning rates and accelerations so all 
terms are positive. Next ¥ was determined by solving 9T X = 0. 

The following illustrates this procedure: 

Referring to (V-ll) let 

f x (0 c ) = 2.425 sin 20 c - 2.22 cos 20 c 

3f l( Q c) = 0 yields 0 C = -23.75° and f 1 (-23.75°) = 3.287 
3 ©T 

f2(0 c ) = 4.85 cos 20 c + 9.05 + 4.44 sin 20 c 

3f 2 (0c) = o yields 0 = +21.25° and f 2 (21.25°) = 15.62 

30 c ° 

f 3 (0 c ) =2.22 cos 2© c - 2.425 sin 2© c 

3f 3 (Qc) = o yields © c = -23.75° and f 3 (-23.75°) = 3.287 

90c 

Next the scanning rates and accelerations are chosen so all terms are 
positive. This yields 

T x = (3.287) (.174) cos + (9.05) (.174) sin <F C + 

C15. 62) (.174) 2 sin \ + (3. 287) (. 174) 2 sin * c 


(V-14) 
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Evaluating 8T X = 0 yields ¥ c = 58°. This value gives 



T x = 1.97 lb-ft-sec^ 

upper bound 

The disturbing torques computed are comparable in magnitude to 
the torques available from the RCJ thrusters which for comparison purposes 
are listed at the bottom of Table 1. The conclusion to be drawn is that 
for the dimensions, mass, and scanning rates and accelerations assumed, 
the disturbing torques are significant. Equations (V-8) , (V-9) , (V-10) 
and the procedure outlined for computing an upper bound on the disturbing 
torque can be used to study the effect of changes in the parameters of 
the TV camera and mount. 
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T x Calculations 


0 C 

deg 

*c 

deg 

0c 

deg/sec 

*c 

deg/sec 

0 C 

dee/sec2 

Tc 

de^/sec^ 

Torque 

lb-ft 

-23.75 

20 

10 

10 

0 

0 

.2900 

21.25 

0 

10 

10 

0 

0 

.469 

45.0 

0 

10 

10 

0 

0 

.3021 

21.25 

18.6 

10 

10 

10 

10 

.9477 

-23.75 

81 

10 

10 

10 

0 

1.6953 

0 

63.9 

10 

10 

10 

-10 

1.8294 

-23.75 

63.9 

10 

10 

10 

-10 

1.8742 

— 

58 

10 

10 

10 

-10 

1.97* 



T 

3 

r Calculations 



11.65 

— 

10 

10 

— 

10 

.223 

21.25 

— 

— 

0 

— 

10 

.2595 

-30.85 

— 

10 

10 

— 

10 

1.16125 




Calculations 



21.25 

90 

10 

10 

0 

10 

.4729 

-23.75 

26.8 

-10 

10 

10 

10 

1.87688 


* Upper-bound 

note: RCJ torques are: 

T x = 1.8 lb-ft 
Ty = 1.28 lb-ft 
T z = 1.28 lb-ft 


Table 1. Disturbing Torques due to Motion of Television Camera 




















VI. CONCLUSIONS AND RECOMMENDATIONS 


One objective of this study was to design a highly reliable attitude 
control system for experiment pointing, station keeping, docking and 
separation from the target for the CARD space vehicle. The design 
presented herein is based on using a RCJ attitude control system and/or 
a CMG attitude control system. The combined system was designed so 
that the torques from each system are never in opposition and to minimize 
cross-coupling of the axes. 

The RCJ attitude control system uses a no-fire region similar to 

that employed on the Skylab program [2]. A modification was introduced 

which results in more predictable phase-plane trajectories for the 

Y-axis and Z-axis control systems and shows promise of improved 

performance. In essence, in place of controlling <j> y and <j> z , the Y-axis 

attitude and Z-axis attitude respectively, the feedbacks are arranged 

so that (<P z + <f>y) and (<J> Z “ <}> y ) are being controlled. If the phase- 

plane trajectories are plotted as (A^ z <j> z + A^ $ y ) vs (<J> Z + <J> y ) and 

• • • • 

(Ai _<)>_ - A, <p ) vs (d> — d> ) rather than d> vs <k and 4> vs <f> then 

14 ^ ly y 2 y Z z y y 

the trajectories can be superimposed on the no-fire boundaries. More 
test runs need to be made to evaluate this system. 

The CMG system simulated for this study uses the optimum steering 
law described in [4]. This steering law was chosen for convenience; 
the approach to designing the system was general and could have employed 
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any steering law. The state-space analysis of the CMG system led to 
the required structure of the input matrix (steering law) and of the 
feedback matrix if the system axes are to be decoupled. The opt im um 
steering law and proportional-plus-rate feedback are shown to be 
special cases. Additional work is needed to determine if this approach 
will lead to better steering laws and feedback schemes. 

In the attitude control system using both the CMG's and the RCJ's 
the feedback for the Y-axis and the z -axis are the sum and difference 
signals. The torque reversal line of the CMG system was designed to 
be in the middle of the RCJ system no-fire region. With this design 
the two systems never produce opposing torques. Additional phase-plane 
trajectories are needed to fully evaluate this system and other CMG 
torque reversal lines need to be investigated. 

Another objective of this study was to derive a procedure for 
computing the disturbing torques due to the motion of the on-board 
TV camera. The equations for the torques in terms of the TV camera 
and mount inertias and scanning rates and accelerations were derived. 

A simplified procedure for computing the upper bound (but not the least 
upper bound) of the torques was outlined. More precise computations 
can be made once the camera requirements are better defined. 
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APPENDIX 


ATTITUDE CONTROL SYSTEM SIMULATION PROGRAM 


RCJ Attitude Control System - Linear Signal Mixing - Sum and Difference 
Feedback 

and/or 

CMG Attitude Control System - Optimum Steering Law - Sum and Difference 
Feedback 


DELT 

PRDEL 

FINTIM 

INERTX 

INERTY 

CUTOFF 

GSTOP 

FPX 

FPY 

FPZ 

AMX 

AMY 

AMZ 

RLDGX 


Input Data 

Integration step size, seconds 

Print increment, seconds 

Total simulation time 

x-axis moment-of-inertia, lb-ft-sec 2 

y-axis moment-of-inertia, lb-ft-sec 2 

Minimum absolute value of det [A] 

Gimbal stop, radians 

x-axis position feedback gain 

y-axis powition feedback gain 

z-axis position feedback gain 

x-axis acceleration due to RCJ thrusters 
deg/sec 

y-axis acceleration due to RCJ thrusters 
deg/ sec 

z-axis acceleration due to RCJ thrusters 
deg/sec. 

x-axis rate ledge, deg/sec 
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RLDGY 

RLDGZ 

PDB 

TQMTRL 

PHIX 

PHIY 

PHIZ 

DPX 

DPY 

DPZ 

DEL 11 
DEL 12 
DEL 13 
DEL 31 
DEL 32 
DEL 33 


y-axis rate ledge, deg/sec 
z-axis rate ledge, deg/sec 
Deadband, deg 

Torque motor rate limit, rad/sec 

Initial value of x-axis angle, deg 

Initial value of y-axis angle, deg 

Initial value of z-axis angle, deg 

Initial value of x-axis rate, deg/sec 

Initial value of y-axis rate, deg/sec 
Initial value of y-axis rate, deg/sec 

Initial value of 611, deg 

Initial value of 612, deg 

Initial value of 613, deg 

Clamped value of 631, deg 

Clamped value of 632, deg 

Clamped value of 633, deg 
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RtAL MXCMND,MYCMNC,MZCMND,MXCMDE .MYCMDE ,MZCMDE,MRX, MRY,MKZ,MTRXC, 
% INERTX, INERTY,INERTZ,K1,M2,M3,M1 INT,M2INT,M3INT 

COMMON RADI AN, INERTX, INERT Y, INERT Z,FPX, FPY,FPZ ,FDPX ,F DP Y, FCPZ 
COMMON/Bl/DLCTll,OinT12,OLDT13,MXCMND,MXCMDE,MRX,MRY,MRZ,MTRXD, 

$ DD7IIC, CO TI2C»C0T13C,0EL31R,0ELT2R,DEL33R, CUTOFF, GST CP, 

$ fcX,EY,EZ,ODPXT,CDPYT,DDPZT,TRXV,TRYV,TRZV 

COMMCN/BA/A1X, AIY,AIZ, PRX,PRY, PRZ 
CELT =0.02 
PRDEL =0.2 
F 1 NT I M=60 . 

INERTX=1127. 

INERTY=29A7. 

INERTZ=2918. 

CUTOFF= .05 
GS T0P = 3 . 
f P X = 7CC . 

FP Y= 1000. 

FP/= 1000 . 

AMX = .208 
AM Y = .0 391 
AMZ= . 03 78 
RLCGX = . 172 
RLCGY = . 172 
RLCGZ = . 172 
PDB= . 3 

X 1=A. *PC8*AMX+RL0GX**2 
Y1=A.*PCB*AMY+RLDGY**2 
Zl=A. *PCB*AMZ+RLDGZ**2 

X2 = 8.*AMX’M2.*AMX*P0B**2-P0B*RLDGX**2) 

Y2=8.*AMY*( 2.*AMY*PDB**2-PCB*RLDGY**2 ) 

Z2=8.*AMZ*( 2.*AMZ*PDB**2-PDB*RLDGZ**2 ) 

PRX=(X1+SGRT (Xi**2-X2) )/ (A.*AMX ) 

PRY=( Yl+SCRT(Yl**2-Y2> )/(A.*AMY) 

PRZ=( Zl+SQRT ( Z l**2-Z2 ) )/(A.*AMZ) 

A1X=SCRT( ( PRX+PDB )/(2.*AMX> ) 

A1Y=SCRT( (PRY+POB)/( 2.* AMY) ) 

A1Z = SCRT( ( PRZ + PDB )/{ 2.*APZ ) ) 

WRITE(6,20)A1X,A1Y,A1Z 
WRITE (6,30)PRX,PRY,PRZ 

20 FORMAT {• l' , »AIX = • , E 1 3 . 5 , A X , • A l Y = • ,E 1 3 . 5 , A X , » A 1 Z *»,E13.5/) 

30 FORMA T ( * ‘,'PRX = • , E 1 3 . 5 , A X , • PR Y = • , E 1 3 . 5 , A X , • PRZ = • ,E 13. 5//// ) 

PHIX=5. 

PFi I Y = C • 

Ph IZ = 0 . 

DP X =0. 

DP Y =0. 

DPZ =0. 

DEL 11 = 0. 
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DEL i 2-0 . 

CEL 13 = C • 

MiINT=G. 

M2INT=C. 

M3 IN T = 0 • 

DEL 3 1 = 4 5 • 

DcL32=45. 

DE L 3 3 =4 5 • 

RADIAN-57.29578 
DEL11R=CEL11/RADIAN 
0EL12R=0EL12/RADIAN 
DEL 13H = DEL 13/RADI AN 
DEL 3 IR = DEL 3 1/RADIAN 
DEL32R=0EL32/RADI AN 
DEL33R=CEL33/RAOI AN 
TEST=- CELT/2. 

TIME=C.0 
FUEL=C • 

DO 9CC I=l,lCCCCOO 
IFITIME.GT.FINTIMIGO TO 1COO 

CALL FCN( TIME, PHI X,DPX, PHI Y.DPY, PHIZ, DPZ , 

$ CELUR,CEL12R,DEL13R,M1INT,M2INT,M3INT, 

$ FCN 1 , FCN2 ,FCN3»FCN4,FCN5*FCN6, 

* FCN7 t FCN8,FCN9,FCN10,FCNil,FCN12) 

SUM=PH IY+PHIZ 
DIFF=PF IY-PHIZ 
DSUM=A1Y*DPY+A1Z*DPZ 
DD IFF = A 1Y«DPY-A1Z*DPZ 
DDPXT = 0 . 

DDPYT = 0 . 

DDPZ T = 0 . 

FUtL A = 0 . 

IF (A8S(EX).LT.PDB) GO TO 100 
CDPXT=CDPXT + S IGNI AMX,EX ) 

FUELA=FUFLA+4.*DELT 
100 IF(A8S(£Y).LT.PD8) GO TO 110 
DDPYT=CDPYT+.5*SIGN{ AMY,EY ) 

CDPZT=C0PZT+.5*SIGN( AMZ,EY) 

FUELA=FUELA+2.*DELT 
110 IF (ABSIEZ l.LT.PDB) GO TO 120 
DDPYT=CDPYT-.5*SIGN(AMY,EZ) 

CDPZT=CCPZT+.5*SIGN( AMZ,EZ) 

FUELA=FUELA+2.*DELT 
120 CONTINUE 

AB11=AES(DEL11R ) 

AB12=AES(DEL12R ) 

AE13=A6S{0EL13R) 

TFIABll .GE.GSTOP.CR.A012 .Ge.GSTOP.OR.AB13.GE.GSTOP)GO TO 510 
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IF(ABS(CDPXT).GT.AMX/4.0) GO TO 3CO 
IF(AeS(CDPYT).GT. AMY/4.0) GO TO 3CO 
IF( AES( CDPZT) .GT.AMZ/4.0) GO TO 3C0 
IF (TIMt.LT.TtST) GO TO 400 
TtST=TEST+PRC£L 
GO TO 310 
3C0 CONTINUE 

PROOX=CDPXT*MRX 
PRGDY=CCPYT*MRY 
PRCOZ=CDPZT*MRZ 
I F ( PRCOX.L T .0 . ) WR I TE ( 6 » 1 97 ) 

IF(PRCCY.LT.O. ) WRITt(6,198) 

I F ( PRCCZ.LT .C . ) WRITE(6,199) 

197 FORM A T ( * • , • * **X- A X I S GAS THRUSTERS OPPOSE CMGS***') 

198 FORMAT (• »,****Y-AXIS GAS THRUSTERS OPPOSE CMGS***') 

199 FORMAT (• • , 1 ***Z-AX I S GAS THRUSTERS OPPOSE CMGS***') 

310 WRITE (6,200 )T IME,PHIX, TRXV , COPXT , OPX 

WRITE ( 6, 201 )PHIY, TR Y V , CCP Y T , DP Y 
WRITE(6,202)PHIZ,TRZV,DCPZT,DPZ 
WRITE(6*203)GEL11,CEL12»CEL13»MTRXD 
WRITE (6, 2 04) SUM, DSUM.D IFF, CD IFF 
WRITE(6,205)FUEL 
4C0 FUEL=FUEL+FUELA 

CALL INTGRL(TIME,CELT,FCNl,FCN2,FCN3,FCN4,FCN5,FCN6, 
$ FCN7,FCN8,FCN9,FCN10,FCNli,FCN12, 

$ PHIX, CPX, PHIY, DPY,PHIZ,DPZ, 

* CEL11R,0EL12R,DEL13R,M1INT,M2INT,M3INT) 

OEL 1 1=DEL 1 IR*RADI AN 
DtLl2=CEL 12R*RADIAN 
DtL13=CEL 13K*RADI AN 
TIME=T IME+DELT 


9C0 CONTINUE 
GO TO 1C00 

910 WRITE(6»920) 

920 FORMAT!' • , • *#=M‘G I MBAL ANGLE EXCEEDS 
WRITE (6,200 ) TIME, PHIX, TRXV, DDP XT, DPX 
WRITE (6,201 )PHIY,TRYV,CDPYT»CPY 
WRI TE (6,202 ) PHIZ, TRZV, OOP ZT ,DPZ 
WRITE (6, 204) SUM , DSUM , D I F F , CD I FF 
WRITE (6, 2 03 ) 0 EL 1 1 , DE L 1 2 , CEL 1 3 , M TRXD 
WRITE(6,205)FUEL 

200 FORMA T ( * ','TIME = • , E 1 2 . 4 , 5X , • PH I X 

$ 5X, 'COPXT ® , E 1 3 . 5 , 5X , » OPX 

201 FORMAT( 25X, 'PHIY = • , E 1 3 . 5 , 5X , • TR YV 

$ 5X,'CPY ='*E13.5) 

202 FORMAT (25X, 'PHIZ = • , E 1 3 . 5 , 5X , ' TRZ V 

i 5X , ' CPZ = ' , E 1 3 . 5 ) 

203 FORMA T (25X, 'CEL1 1 = ' , E 1 3 . 5 , 5X, ' DEL12 


GIMBAL STOP****') 


=' ,E13.5,5X, • TRXV 
=' , E 1 3 . 5 ) 

= ' ,E13.5,5X, 'DDPYT 
*' » E 1 3. 5 , 5X, 'CDPZT 
=• ,E13.5,5X, 'DEL13 


= ' , E 1 3 . 5 , 
=',E13.5, 


= ' t E 1 3 . 5 , 
=',E13.5, 
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% 5X f ' M TR X0 =* ,E13.5) 

2 04 FORMA f( 25X« • SUM = ' » E 1 3 . 5 , 5X » • D SUM 

$ 5X» 'CD IFF =*,E13.5) 

205 FORMAT ( 25X ( * FUEL = # ,E13.5/) 

1C00 STEP 

ENC 


=• tE13.5»5X»*DIFF =»,E13.5, 
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SOUR CL T I Nfc I NTGRL ( T »H » FCNl , FCN2 » FCN3 , FCN4 » FCN5, FCN6 , 

i FCN7,FCN8 f FCN9,FCNl0.FCNll,FCN12,Yl,Y2,Y3,Y4,Y5,Y6, 

$ Y7,Y8fY9»Y10»Yll,Y12) 

H2=H/ 2 • , 

CALL FCN(T,Yl*Y2,Y3*YA,Y5,Y6,Y7,Y8fY9,Yl0.Yll, Y 12 ♦ FCN l , FC N2 , FCN 3 , 
$ FCN4,FCN5,FCN6,FCN7,FCN8 t FCN9, FCN 10, FCN 1 1 ♦ FCN 12 ) 

P1=H*FCN1 
P2=H*FCN2 
P3=H*FCN3 
P4=H*FCN4 
P6=H*FCN5 
P6=H*FCN6 
P7=H*FCN7 
P8=H*FCN8 
P9=H*FCN9 
P 1 0 = H* FCN 10 
P 1 1 = H*FCN 1 1 
P12=F*FCN12 

CALL FCN< T + H2 .Yl+Pl/2. t Y2+P2/2. ,Y3+P3/2. .Y4+P4/2. ,Yf>+P5/2.» 

$ Y6+P6/2. »Y7+P7/2. »Y8+P8/2.» Y9+P9/2., Y10+P10/2. , Yll + P li/2.* 

* Y12+P12/2. f FCNl,FCN2»FCN3, FCN A, FCN 5 , FCN6 » FCN7 ♦ FCN8 » FCN9 , 

$ FCNIOfFCNllt FCN 12 ) 

Q 1 =H* FCN 1 
Q2=H*FCN2 
Q3=H*FCN3 
Q4 = H* FCN4 
Q5=H*FCN5 
Q6=H*FCN6 
Q7-H*FCN7 
Q8=H*FCN8 
Q9=H*FCN9 
Q10 = H*FCN 10 
Q i 1 = H*FCN 1 1 
0 i 2 = F*FCN 12 

CALL F CN ( T + H2 » Yl+Cl/2. # Y2+Q2/2» »Y3+Q3/2. »Y4+CA/2» • Y5 + Q5/2. » 

$ Y6+Q6/2..Y7+C7/2. ,Y8+Q8/2.,Y9+09/2. tY10+Q10/2. ,Yll + QU/2., 

$ Y12+G12/2. ,FCNi,FCN2»FCN3,FCNA,FCN5,FCN6,FCN7,FCN8,FCN9, 

$ FCN10»FCN11»FCN12) 


R 1=H*FCN 1 
R2=H*FCN2 


R3=H*FCN3 
R4=H*FCN4 
R5=H*FCN5 
R6 = H* FCN6 


R7=H*FCN7 

R8=H*FCN8 


R9=H*FCN9 

R10=H*FCN1G 
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R 1 1=FI*FCN 1 1 
R12=H*FCN12 

CALL FCN( r+H,Yl+Rl t Y2+R2,Y3+R3,YA+RA f Y6+R5,Y6+R6,Y7+R7,Y8+R8, 

Y9+R9»Y10+R10»Yll+Rll t Y12+R12,FCNl»FCN2»FCN3»FCNA t FCN5»FCN6* 
FCN7»FCN8,FCN9#FCN10»FCN11»FCN12) 

S1=H*FCN1 

S2=H*FCN2 

S3=H*FCN3 

S4=H*FCN4 

S5=H*FCN5 

S6=H*FCN6 

S7=H*FCN7 

S8=H*FCN8 

S9=H*FCN9 

S10 = H*FCN 10 

SU=H*FCNll 

S12=H*FCN12 

Y1=Y1+ (Pl+2.*(Ql+Rl)+Sl)/6. 

Y2=Y2+(P2+2.*(Q24R2)+S2)/6. 

Y3=Y3+( P3+2.*(«3+R3)+S3) /6. 

Y4=Y44 ( P442.*(QA+RA ) + SA) /6. 

Y5=Y54 { P5+2.*(C5+R5)+S5)/6. 

Y6=Y64( P642.*(Q64Rfc)+S6)/6. 

Y7=Y74{ P742.*(Q74R7)4S7)/6. 

Y8=Y84( P842.*(C84R8)4S8>/6. 

Y9 = Y94( P<J42.*( Q94R9)4S9)/6. 

Y10=Y lC+( P10+2.*(Q10+R10>4S10)/6. 

Yli*Yll4(Pl l42.*(Cll4RH)4Sll)/6. 

Y12=Y124(P1242.*( C124R12)4S12)/6. 

RETURN 

END 
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SUBROUTINE FCN(TIP£,PHIX,DPX,PHIY,DPY,PHIZ,DPZ, 
i D£L11R*D£L12R»DEL13R»PIINT,M2INT,M31NT» 

$ FCN1,FCN2,FCN3,FCN4,FCN5,FCN6,FCN7,FCNB, 

$ FCN9,FCN10,FCNll,FCN12> 

KlAL FXCMN0,FYCMND,MZCMND,PXCMDE,KYCPDE,MZCPDE,PRX, PRY,MRZ, PTKXC, 
$ INERTX, INERTY, INERT Z , P 1 , M2 , P3, W 1 INT, F2INT,M3INT 

CGPPCN RAC I AN, INERTX, INER TY , INER TZ ,FPX, FPY,FPZ ,FDPX , FDPY , FDPZ 
COPtfON/Bl/CLCTll,DLDTi2,DLDT13,PXC*NC,MXCMDE,FRX,VRY,PRZ,PTRXD, 
i DDT11C,CDT12C,CDT 13C , DEL3 1R ,DEL 32R, DEL33R , CU TOFF , GSTO P , 

$ EX,EY,EZ,ODPXT,CDPYT,CCPZT,TRXV,TRYV,TRZV 

CUFF1CN/B4/A1X, A 1 Y , A 1Z , PR X , PR Y , PR Z 
A 1 1 = SIN{DEL11R)*C0S(DEL31R) 

A 1 2= CCS(D£L12R) 

A13=-S INI DEL 13R )*SIN( DEL3 3R ) 

A2L=-SIN( OELUR ) * S IN < DEL 3 1R ) 

A2 2= SIN(DEL12R)*COS(DEL32R) 

A23= CCSIDEL13R) 

A3 1= CCS(DELIIR) 

A32=-SIN(0EL12R)*SIN(DEL32R) 

A 3 3= SIN{CEL13R)*CCS(DEL33R) 

PTRXD= A1 l*A22*A33+A12*A23*A31+A21*A32*A13 
t -A13*A22*A31-A12*A21*A33-A23*A32*A11 

IF ( ABS( KTRXO ) .LT. CUTOFF )PTRXD=SIGN (CUTOFF, PTRXD) 

T 1 1 = ( A22*A23-A23*A32)/MTRXD 

T 12=( - A 12*A33 + A13*A32)/MTRXD 

T 1 3= ( A 12*A23-A13*A22)/PTRXD 

T21=(-A21*A33+A23*A31)/*TRXD 

T22= ( A11*A33-AL3*A31)/MTRXD 

T 2 3= ( -A 1 1*A23+A13*A21 ) /MTRXD 

T 3 1 = ( A2l*A32-A22*A31 I/NTRXD 

T32= (-A 1 1*A32+AI2*A31 ) /MTRXD 

T 3 3= ( A ll*A22-A12*A21 I/MTKXD 

DDTI1R=5.*P1INT 

DDT12R-5.*P2INT 

DDTI3R = 5.*N'3INT 

DLCT1I=CDTUR*RA0IAN 

CLCT12=COT12R*RADIAN 

DLCT13=CDT13R*RACIAN 

PX F = PH I X 

PYE=PHI Y+PHIZ 

PZF=PF I Z— PHI Y 

IF (ABS( PXF ) .GT.PRX) PXF = S I GN ( PRX , PXF ) 

IF(ABS(PYF).GT.PRY) P YF = S I GN ( PRY , P YF ) 

IF (ABS( PZF ) .GT.PRZ ) PZF = S I GN C PRZ , PZF ) 

EX=-(AIX*DPX,+ PXF) 

EY=-( AIZ*CPZ+A1Y*CPY+PYF ) 

EZ=-( AIZ*DPZ-A1Y*DPY+PZF) 

PXCMNC=FPX*EX/RADIAN 
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RYCMNC=FPY$( EY-EZ ) /RAD IAN 
RZCMNC=FPZ*( EY+EZ ) /RAD IAN 

MRX= ( All*0CTllR+A12*0DT12R*A13*DDri3R)*60. 

MKY= { A21*CCT11R+A22*CDT12R+A23*D0T13R )*60. 

PRZ= ( A31*DCT1 1R+A32*CDT12R*A33*DDT13R )*60. 

TRXV=RADIAN*RRX/IN£RTX 

TRYV=RADI AN*PRY/INERTY 

TftZV=RACI AN*MRZ/INERTZ 

RXCMCe=RXCNNC-MRX 

PYCHCE=RYCRND-MRY 

MZ CMD E = PZ CMNC-MRZ 

DDTL1C= (Tll*RXCMDE+T12*PYCMDE+T13*PZCMDE)/60. 
DDT12C= (T2l*PXCMDE+T22*PYCHDE+T23**ZCMDE)/60. 
CDT13C={ T31*RXCMDE+T32*RYCMDE+T33*PZCMDE )/60. 

DDT1 1G=2.*DDT 1 1C 
DDT 12G=2.*D0T12C 
0DT13G=2.*CDT13C 
TCMTRL=4. 5/RAOIAN 

IF (AeS(CDrilG) .GT.TQMTRUCDTI1G=SIGN{TQPTRL,DDTIIG) 

I F ( ABS{ CDT12G) .GT . TQMTRL ) CDT 12G= S IGN ( TQMTRL , DDT12G ) 

IF(AES(CDT13G) .GT . TCMTRL ) DDT 1 3G= S I GN ( TQPTRL , DDT 1 3G ) 

FCN1=CPX 

FCN2=TRXV+DDPXT 

FCN3=CP Y 

FCN4=TRYV+CDPYT 

FCN5 = C P Z 

FCN6=TRZV+DDPZT 

FCN7 = C C T 1 1R 

FCN8=CCT12R 

FCN9=CCT I 3R 

FCN10=DDT11G-DDTIIR 

FCNI1=CDT12G-CDTI2R 

FCN12=CDT13G-CDT13R 

RETURN 

END 



